clc
clear all

Speed           = 10; % Arbitrary scale. 
StartPoint      = [3280542.7485, 369513.8670]; % 20.1392
EndPoint        = [3280542.7485, 369523.8670]; % 20.1392

CurrentPoint    = StartPoint + .1;
LastPoint       = StartPoint - .1;

ReqHeading      = (EndPoint(1) - CurrentPoint(1))/(EndPoint(1) - CurrentPoint(1));
atan(ReqHeading)*180/pi;

x = 1;
y = -1;
angle = atan(y/x)*180/pi;
fprintf('Angle = %f\n',angle);






